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融合 到 达 角 的 粒子 滤波 寻 源 方法 研究 
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定位 是 核 安检 、 核 应 急 领域 的 重要 
融合 到 达 角 的 粒子 滤波 寻 源 方法 。 首 先 ， 构 建 了 自主 定位 与 对 
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次 ， 在 粒子 滤波 基础 上 考虑 到 


达 角 信息 ， 动 态 收缩 放射 源 搜 寻 区 域 ， 进 而 提高 搜寻 效率 最后， 在 自主 寻 源 路 径 规 划 中 采用 到 
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达 角 引导 的 机 器 人 姿态 调整 ， 增 强 机 器 人 寻 源 的 灵活 度 。 仿 真实 验证 明 此 方法 可 正确 
利用 放射 源 开 展 的 测试 进一步 验证 了 该 方法 对 于 多 源 搜寻 的 实用 性 。 
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目前 ， 我 国 核电 机 组 数量 已 进入 世界 前 列 ， 投 入 核电 机 组 共 55 台 ， 位 列 全 球 第 二 ， 在 建 核电 机 组 22 
台 ， 连 续 多 年 世界 第 一 帆 。 另 外 ， 我 国 放射 源 和 射线 装置 在 放射 诊疗 、 辐 照 加 
科学 研究 等 领域 的 应 用 也 十 分 广泛 。 截止 2022 “EE, 全国 从 事 生产 、 销 售 、 使 ) 
万 余 家 ， 在 用 放射 源 15.7 万 枚 ， 各 类 射线 装置 23 万 多 台 外 。 随 着 各 类 放射 源 大 量 推广 使 / 


放射 性 泄露 等 紧急 情况 的 应 急 处 置 方法 正成 为 保障 核 工 业 健康 发 展 的 重要 课题 。 
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二 乘法 和 最 大 似 然 估计 法 处 理 传 感 
核 辐射 探测 器 构建 了 一 个 固定 的 
内 部 署 四 个 核 辐射 探测 器 形成 传感器 网 络 ， 利 上 
最 大 似 然 估计 算法 ， 通 过 系统 位 置 结合 每 个 Nal 探测 
以 上 的 方法 在 面 对 单 个 放射 源 估计 时 


中 通过 在 房间 
Curtis 4514) 
最 有 可 能 的 放射 源 二 维 分 布 
辐射 场 内 存在 多 个 放射 源 时 ， 观 测 值 是 多 个 源 的 累积 强度 ， 同 时 
息 准 则 估计 放射 源 位 置 ， 其 考虑 了 辐射 场 的 故 加 ， 但 该 人 
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非常 有 效 ， 但 不 适用 
源 的 数量 也 未 知 。Ding 等 四 使 用 


源 的 位 置 ， 
量 期 间 


于 多 源 估 计 。 当 


jj， 针对 丢失 源 、 


因为 大 剂量 的 失控 放射 源 会 对 暴露 在 附近 的 人 员 造 成 危害 ， 而 且 放 射 源 无 色 无 味 、 不 易 码 觉 ， 如 何 快 
外 的 找到 放射 性 热点 区 域 成 为 失控 源 应 急 处 置 的 首要 问题 。 
早期 的 定位 方法 主要 依靠 在 辐射 场 环境 中 构建 传感器 网 络 ， 利 用 几何 法 、 
的 大 量 观 测 数据 来 估计 放出 


最 小 
源 的 位 置 ， 例 如 ，Rao 等 引 使 用 三 个 
几何 法 对 开阔 区 域 放 射 源 位 置 进行 估计 ，Howse 等 


最 小 二 乘法 实时 估计 移动 放 复 
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果 , 他 们 证 


法 需要 已 知 的 辐射 
明 随 着 放射 源 数量 的 增加 贝 叶 斯 估计 
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在 没有 部 署 传感器 阵列 的 地 方 ,上述 方 法 不 能 对 辐射 场 内 各 个 位 置 剂 量 信息 进 行 精确 测量 , 相 比 之 下 ， 
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搭载 探测 器 的 移动 机 器 人 具有 更 大 的 优势 ， 由 于 移动 机 器 人 无 法 瞬时 测量 整个 辐射 场 ， 因 此 序列 估计 是 此 
类 研究 的 常见 策略 &I0。Mascarich 等 上 根据 平方 反比 定律 生成 一 组 潜在 放射 源 ， 通 过 后 验 概率 分 布 对 放射 
源 位 置 进行 估计 。 为 提高 估计 效率 ，Park 等 (2 提出 了 一 种 基于 多 传感器 融合 的 估计 方法 ， 该 方法 可 以 利用 
不 同 传感器 的 测量 结果 同时 更 新 粒子 权重 。 关 于 多 源 估计 问题 ，Gao 等 0 提出 了 峰值 抑制 粒子 滤波 器 
(PSPF)， 将 该 问题 视 为 非 参数 估计 ， 其 运行 时 间 与 粒子 层 数 成 正比 ，Wang 等 (4 融合 了 高 斯 过 程 和 PSPF 
框架 (GP-PSPF)， 以 提高 源 强 度 不 同情 况 下 的 估计 精度 ，Bai 等 05 提 出 了 一 种 新 颖 的 在 线 多 辐射 源 估计 框 
架 ， 该 方法 以 增 量 方式 构建 中叶 斯 估计 状态 空间 ， 多 层 粒子 同时 更 新 ， 以 适应 不 同 的 辐射 场景 ， 徐 航 09 
提出 了 响应 矩阵 反 卷 积 方法 对 地 面 多 放射 源 分 布 进行 反 求解 ， 结 果 表 明 该 方法 可 以 在 未 知 放射 源 先 验 信息 
的 情况 下 对 多 枚 放射 源 的 位 置 和 活 度 进行 估计 。 

针对 当前 使 用 纯 粒 子 滤波 算法 对 放射 源 搜 寻 过 程 存在 定位 精度 低 、 只 能 寻 单 源 等 问题 ， 本 文 提出 了 一 
种 融合 到 达 角 的 粒子 滤波 寻 源 方法 。 首 先 ， 通 过 激光 雷达 构建 二 维 栅 格 辐射 场地 图 ， 实 现 机 器 人 自主 导航 
和 定位 ;其 次 ， 使 用 旋转 探测 器 获得 到 达 角 信息 ， 融 合 改进 粒子 滤波 算法 ， 动 态 更 新 粒子 集 区 域 ， 最 后 ， 
机 器 人 根据 到 达 角 信息 进行 姿态 调整 ， 实 现 对 多 个 未 知 放射 源 的 渐进 式 搜 寻 。 本 文 开 展 了 对 放射 源 搜 寻 的 
仿真 实验 和 真实 搜寻 实验 ， 结 果 表 明 该 方法 的 有 效 性 。 


1 原理 和 方法 


11 核 辐 射 探测 模型 
本 文 以 各 向 同性 的 点 源 为 基础 建立 辐射 探测 模型 ,适当 简化 理论 分 析 复 杂 度 ， 再 结合 工程 应 用 进行 调 


整 和 优化 。 假 设 空气 中 放射 源 A 的 活 度 为 4 ， 则 探测 器 在 观测 点 @ 处 测量 得 到 的 辐射 计数 率 为 : 


oes o 
其 中 Ro 为 观测 点 9 和 放射 源 A 之 间 的 欧 氏 距离 (m)，s 为 辐射 探测 器 有 效 探测 面积 (m? )，p 为 探测 效 
放射 源 在 空气 中 会 释放 y 射线 ， 而 空气 中 障碍 物 对 y 射线 有 衰减 作用 ， 若 不 考虑 空气 衰减 系数 ， 则 在 

观测 点 @ 处 测量 得 到 的 辐射 计数 率 为 : 
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其 中 入, 为 物质 m 的 厚度 (m)， 为 物质 m 的 y 射线 衰减 系数 (m7 )。 

王 何 环境 中 都 存在 本 底 ， 假 设 环 境 中 本 底 计数 率 为 (cps)， 则 在 观测 点 © 处 经 过 秒 测量 ， 得 到 的 辐 


射 计 数值 4。 为 : 
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ATR‘ 
在 真实 辐射 场 环境 中 探测 器 的 探测 效率 及 有 效 探测 面积 等 参数 难以 测量 

射 源 Im 处 的 计数 率 了 为 这 些 参 数 的 计算 总 和 ， 则 辐射 计数 值 4 等 效 为 : 
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此 定义 辐射 探测 器 距离 放 
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若 辐 射 环境 中 存在 k 个 放射 源 (k>1D)， 忽 略 放射 源 之 间 的 相互 作用 ， 放 射 源 活 度 用 A 表示， 其 中 


1<j<k， 则 在 观测 点 © 处 测量 得 到 的 辐射 剂量 值 是 k 个 放射 源 剂 量 值 共 同 合 加， 此 时 A, 为 : 


žo =È (G0, AD) +7,)r (5) 

探测 器 在 辐射 场 中 能 够 测量 单位 时 间 内 的 y 射线 粒子 数 ， 该 剂量 信息 存在 上 下 起 伏 现象 ， 其 实际 计数 

率 与 理论 计数 率 服从 泊 松 分 布 关系 07-9， 若 放射 源 单位 时 间 内 发 射 w 个 粒子 ， 辐 射 探测 器 在 r 秒 内 对 粒子 
计数 为 Z 的 概率 为 : 
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PsA) =e" (6) 


其 中 4=Wr ，ZeN 为 实际 计数 率 (cps)，4 为 探测 器 的 期 望 计 数 率 (cps)。 
对 于 寻 源 过 程 中 ， 第 ; 点 的 计数 率 测量 值 为 六 ， 其 对 应 的 理论 值 为 到 ， 则 式 (60) 可 以 表示 为 : 


PC 人 (7) 
12 自主 定位 与 到 达 角 感知 相 结合 的 寻 源 
图 1 给 出 了 一 台 移 动机 器 人 自主 探测 搜寻 放射 源 的 工作 示意 图 ， 机 器 人 搭载 核 辐射 探测 器 和 自主 导航 
系统 ， 对 应 的 核心 功能 是 : 放射 源 位 置 估计 和 寻 源 路 径 规划 。 首 先 机 器 人 通过 激光 雷达 构建 辐射 场 二 维 栅 
格 地 图 ， 机 器 人 在 辐射 场 中 沿 指定 路 线 行驶 ， 当 探测 器 探测 到 所 处 环境 中 辐射 剂量 信息 达到 本 底 值 的 两 倍 
时 ， 判 定 辐射 剂量 信息 异常 ， 辐 射 探测 器 开始 进行 旋转 ， 旋 转 探 测 器 转动 一 周 采集 不 同 角 度数 据 ， 同 时 获 
得 每 个 角度 数据 对 应 的 辐射 剂量 率 信 息 ， 选 取 最 大 剂量 率 所 对 应 的 探测 器 到 达 角 度 信息 ， 将 探测 器 的 到 达 
角度 信息 经 过 角度 变换 获得 机 器 人 在 世界 坐标 系 中 的 角度 信息 。 最 后 机 器 人 根据 世界 坐标 系 角度 信息 划 定 
粒子 范围 ， 执 行 改进 的 粒子 滤波 算法 ， 实 现 机 器 人 对 放射 源 的 搜寻 和 定位 ， 并 返回 放射 源 在 地 图 中 的 位 置 
言 轧 到 远程 工作 台 。 


13 ”探测 器 工作 原理 
(探测 器 物理 结构 


如 图 2 所 示 为 探测 器 局 部 结构 图 整个 系统 通过 PLC 控制 器 进行 控制 ， 其 包含 两 个 伺服 电机 ， 分 别 控 
制 铅 桶 上 下 运动 和 旋转 运动 。 碘 化 钠 探测 器 位 置 固定 不 变 ， 当 铅 桶 移动 到 最 上 面 时 ， 整 个 碘 化 钠 探测 器 将 
被 屏蔽 ， 此 时 碘 化 钠 探测 器 只 能 通过 铅 桶 上 的 探测 孔 进行 辐射 剂量 率 测 量 ， 铅 桶 旋转 可 得 探测 孔 在 不 同 角 
度 下 所 对 应 的 辐射 剂量 率 。 
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1 系统 搜寻 示意 图 (在 线 彩 图 ) 


化 钠 探测 器 


旋转 控制 电机 


图 2 探测 器 局 部 结构 图 (在 线 彩 图 ) 


(2) 探 测 器 工作 机 制 

本 文中 所 使 用 探测 器 为 碘 化 钠 探 测 器 ， 其 具有 高 灵敏 度 、 快 速 响 应 以 及 良好 的 能 量 分 辨 率 等 特点 ， 当 
! 化 钠 唱 体 被 辐射 时 ， 蝇 格 中 的 原子 被 激发 ,其 中 部 分 能 量 被 释放 成 光子 , 这 些 光子 向 随机 方向 进行 散射 ， 
并 与 晶体 内 其 他 原子 相互 散射 ， 最 终 被 吸收 或 者 逃离 晶体 。 如 果 光 子 被 吸收 ， 则 附近 的 原子 被 激发 使 得 更 
多 光子 进行 发 射 ， 利 用 光电 倍增 管 将 这 些 光 子 转化 为 电子 ， 通 过 对 电子 进行 转化 和 测量 ， 将 其 转化 为 电信 
号 ， 从 而 得 到 辐射 剂量 率 。 

假设 探测 器 的 辐射 剂量 率 采样 频率 为 1 ， 探 测 器 旋转 一 圈 的 时 间 为 五 ， 对 采集 的 辐射 剂量 率 信息 和 角 
度 信 息 进行 时 间 同 步 ， 则 探测 器 旋转 一 圈 采 集 到 的 辐射 剂量 率 信息 和 角度 信息 个 数 都 为 T, 。 如 图 3 所 示 
为 到 达 角 度 测 试 示意 图 ， 定 义 探 测 器 测量 角度 为 9 ， 剂 量 率 为 ， 探 测 器 旋转 一 圈 产 生 的 剂量 率 信息 和 和 角 
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O: 即 为 放射 源 相 对 于 探测 器 的 方向 。 车 放射 源 与 探测 器 之 间 存在 障碍 物 ， 由 于 放射 源 和 探测 器 的 位 置 固定 


不 变 ， 并 且 y 射线 具有 和 穿 透 作 用 ， 此 方法 依然 有 效 。 


O 
图 3 旋转 探测 器 到 达 角 度 测 量 示 意图 (在 线 彩 图 ) 
(3) 探 测 器 基于 到 达 角 测量 原 剧 


结合 上 述 探测 器 的 工作 原理 ， 本 工作 采用 了 一 种 基于 到 达 和 角度 CAOA, of Arrival) 的 自主 寻 源 
算法 。 本 文 定 义 的 AOA 就 是 将 探测 器 采集 到 的 辐射 剂量 率 信 息 和 角度 信息 通过 软件 代码 进行 时 间 同 步 ， 
获得 放射 源 相 对 于 探测 器 的 所 在 角度 范围 , 并 结合 改进 的 粒子 滤波 算法 , 实现 机 器 人 对 放射 源 的 自主 搜寻 。 


HHE 


KR A 观测 点 。 保 留 的 粒子 。 舍 弃 的 粒子 


O X 
图 4 基于 到 达 角 的 粒子 取舍 示意 图 (在 线 彩 图 ) 
如 图 4 所 示 为 基于 到 达 角 的 粒子 取 合 示 意图 ， 机 器 人 观测 点 坐标 为 (x., y,)， 放 射 源 坐 标 为 x.,y,)， 由 


于 探测 器 的 结构 存在 角度 测量 偏差 ， 假设 a 为 允许 的 最 大 偏差 ， 则 放射 源 实际 测量 角度 范围 为 
[O° -a,0° +Q]。 令 pi 为 粒子 ([x,yi,Ii],0@) 相 对 于 探测 器 的 角度 ， 定 义 为 POA TAXA, Particle 
Observation Angle) ， 表 示 如 下 : 


p; =arctan 一 一 Yee (8) 


x 一 和 


其 中 [x ,yi 及] 表示 粒子 的 坐标 和 强度 ，@ 表示 粒子 的 权重 。 


2 融合 到 达 角 的 粒子 滤波 估计 
寻 源 机 器 人 在 辐射 环境 下 进行 剂量 信息 样本 采集 时 ， 贝 叶 斯 估计 模型 很 好 的 解决 了 机 器 人 根据 环境 的 


Fee Ee Ai SR A TS AL BL VD pel AS SHEE Poe PS a IN BS AS BIAS FAN RHE TT SET, BEAN 
子 逐 渐 收 敛 至 放射 源 附 近 ， 主 要 包括 以 下 步骤: 
(D) 系 统 初 始 化 。 假 设 辐射 场 环境 中 存在 若干 个 未 知 放射 源 ， 其 参数 用 向 量 表示 为 4) =[A,A,A T ， 


其 中 (A4;,A)) 表 示 放 射 源 位 置 坐标 ，A; 表示 放射 源 强 度 信息 ， 7 表示 放射 源 个 数 ; 构建 粒子 集 先 验 模型 ， 
在 二 维 平面 内 均匀 产生 NW 个 带 有 各 自 权 值 @ 的 粒子 作为 样本 , 其 中 表示 观测 次 数 。 每 个 粒子 的 参数 应 
K X =y OK<isN)> KPO.) 表示 粒子 位 置 坐标 ， 思 表示 粒子 强度 ， 初 始 化 后 粒子 集合 大 
1 


A o 


i 


(Xo ha AP ears ai, Ara IA] AA Be 


QQ) Mie Ah. HAM k RWE, IR STM Z, > MERETE OX, 中 的 每 个 
BF BAe AN HTT A CN RE Bal X; =[x, yi,L]， 由 泊 松 分 布 概率 ， 粒 子 权 值 更 新 为 : 


æ. =P(Z, | Xi) (9) 


RE, MERI y HE Dol =. 根据 上 文 提出 的 到 达 角 度 进 一 步 更 新 粒子 的 权重 ， 保 留 粒 子 相 对 


AEE -a0 +a) 范围 内 的 粒子 ， 同 时 把 粒子 相对 角 在 [& -ww,2 +a] 之 外 的 粒子 权 值 设置 为 0， 权 值 更 
新 为 : 


ôi = a aaa (10) 
0, pi ¢[0° — 0,0° +a] 
然后 ， 将 新 的 权 值 进行 归 一 化 : 

ali 

QO, = N 
y 11 
> (11) 

i=l 


半 算 法 有 多 种 可 供 选 择 ,， 综合 考虑 采样 质量 以 及 算法 复杂 度 等 因素 ， 本 工作 决定 
采用 系统 重 采样 算法 。 该 算法 包含 计算 粒子 累积 权重 、 均 匀 采 样 、 复 制 粒子 、 替 换 粒 子 等 步骤 ， 使 得 粒子 
更 加 集中 在 具有 较 高 权重 的 状态 附近 ， 提 高 估计 的 准确 性 ， 同 时 避免 了 因为 权重 差异 较 大 而 导致 的 样本 退 
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(4 放射 源 参数 估计 。 在 对 粒子 集合 (Xia à 行 处 理 之 后 ， 粒 子 动态 收敛 到 权 值 较 大 的 区 域 ， 通 过 
加 权 求 和 可 估计 出 放射 源 参数 ， 估 计 值 为 : 
x -> o (12) 
(5) 粒 子 自 适应 更 新 。 为 解决 粒子 多 样 性 减少 对 算法 精 度 的 影响 ， 本 文 根 据 后 验 概率 分 布 的 复杂 度 使 用 
正 态 分 布 动态 调整 粒子 数目 ， 使 得 系统 随 着 观测 次 数 的 增加 ， 粒 子 逐 渐 趋 于 收敛 。 


3 到 达 角 引导 的 寻 源 规划 
机 器 人 自身 姿态 角 计 算 与 调整 影响 到 AOA 测量 和 移动 路 径 规划 ， 下 面 给 出 了 具体 方法 。 


3.1 姿态 角 调 整 
本 工作 采用 的 旋转 探测 器 安装 方式 如 图 5 所 示 ， 探 测 器 正方 向 与 机 器 人 正方 向 相差 6 ， 此 角度 偏差 是 


探测 器 的 安装 方式 导致 物理 结构 设计 需要 ， 由 于 探测 器 零 位 方向 与 机 器 人 正方 向 不 重合 ， 所 以 需要 将 探测 
器 的 角度 值 经 过 角度 变换 转换 为 机 器 人 在 辐射 场地 图 中 的 下 一 步调 整 角 度 。 

在 实际 测试 环境 中 ， 放 射 源 可 能 存在 于 机 器 人 周围 的 任何 一 个 方向 ， 如 图 6 所 示 ， 探 测 器 可 采集 的 角 
度 范 围 为 0 ~ 360， 机 器 人 在 辐射 地 图 空间 中 的 角度 范围 为 -180 ~180 ,本 文 拟 根据 探测 器 的 安装 位 置 将 
旋转 方向 分 为 4 个 区 域 , 分 别 为 DOB@@， 图 中 展示 了 不 同 区 域 探测 器 的 旋转 方向 ， 其 中 五 角 星 标志 表示 
放射 源 可 能 存在 的 位 置 。 

假设 探测 器 测量 放射 源 角 度 为 2 ， 探 测 器 的 角度 区 间 与 机 器 人 下 一 步调 整 角度 对 应 关系 如 表 1 所 示 。 

表 1 角度 转换 关系 图 


传感器 旋转 区 域 机 器 人 下 一 步调 整 角度 
KRO (0 <0<8) 6-0 
XRO (6 < 9 <180) 6-0 
区 域 @ (80 < 6 < 180° +6) 6-0 
区 域 @ (180 +6 <0 <360) 360 +6 -0 


综 上 ， 将 区 域 CDC)@ 合 并 后 的 角度 转换 关系 图 如 表 2 所 示 。 
表 2 合并 后 角度 转换 关系 图 


传感器 旋转 区 域 机 器 人 下 一 步调 整 角度 
X RODO (0 < 4 <180' +4) 6-0 
区 域 @ (180 +6<0<360) 360 +6-0 


探测 器 正 


机 器 人 正方 抽 
方向 


X] 
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图 5 旋转 探测 器 安装 示意 图 (在 线 彩 图 ) 
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机 器 人 士 180_ 


探测 器 180 +O 
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6 旋转 探测 器 探测 示意 图 (在 线 彩 图 ) 


3.2 下 一 观测 点 规划 
当 机 器 人 估计 出 放射 源 位 置 时 ， 机 器 人 需要 根据 步 长 设置 逐步 向 放射 源 估计 位 置 靠近 。 如 图 7 所 示 为 


机 器 人 观测 点 设置 示意 图 。 ACY) 点 为 机 器 人 当前 观测 位 置 ， Bh, 和) 点 为 放射 源 估计 位 置 ， 
CY > DOL did) 两 点 为 机 器 人 下 一 可 能 观测 位 置 ， 则 直线 AB 的 方程 如 式 (13) 所 示 : 


A A 


yA TY 次 一 次 
y= Xt (13) 
Xk T Xk Xk T Xk 


DA 点 为 圆心 ，r 为 半径 形成 的 圆 的 方程 如 下 式 : 


a-n +(y-y,) =r? (14) 


将 式 (13) 和 式 (14) 联 立 可 得 如 下 式 ; 


ax’ +bx+c=0 (15) 
其 中 a、 by, c 参数 如 下 式 : 


a= (+ (Š) 


Xk T Xk 
b= —2x, (1+ (22 4)?) (16) 
Xk T Xk 


c=0 Ag -r 


k T Xk 


求解 式 (15) 可 得 C 点 和 D 点 的 坐标 如 式 (17) 所 示 : 


F —b+ b> —4ac 
ta o 
a 
' 了》 =y ' y =F 
Yk = < £ Xka 十 Yk 一 天 一 一 六 
Xk T Xk Xk T Ak 
(17) 
A b—\b° —4ac 
k+l 2a 
n y n y y 
Yeu = 9 Xn TVA ~ : Xy 
Xk T Xk Xk T Xk 
通过 比较 B、C 两 点 和 B, D 两 点 的 欧 氏 距离 ， 获 得 最 短 距离 对 应 的 点 即 为 下 一 观测 点 ， 和 角度 为 


arctan 


观测 点 逐步 


下 一 。 根 据 以 上 过 程 ， 
Xp — K 

设 定 阔 值 并 且 所 有 粒子 收敛 到 一 个 范围 ， 则 
位 置 。 


He 5 
iJ 


JELL 


近 估计 点 ， 直 到 观测 点 位 置 与 放射 源 估计 位 置 之 间 距离 达到 


代 次 数 才能 寻 源 成 功 ， 而 在 一 般 的 放射 源 搜 寻 过 程 中 可 适当 放宽 阔 值 以 提高 算法 效率 。 
y 
A 当前 观测 点 
o 下 次 观测 点 
@ 放射 源 佑 计 点 (4,5) 


3.3 多 源 定位 方法 


针对 多 个 放射 源 的 情形 ， 


(Xka Yeu) 
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图 7 机 器 人 观测 点 设置 示意 图 (在 线 彩 图 ) 


图 8 多 源 搜寻 流程 示意 图 (在 线 彩 图 ) 


图 8 给 出 了 该 机 器 人 的 搜寻 示意 


图 。 


放射 源 搜寻 结束 ， 此 时 的 放射 源 估 计 参 数 即 为 最 终 放 射 源 估 计 
其 中 距离 闪 值 设 定 范 围 需要 根据 实际 应 用 需求 进行 设 定 ， 较 小 的 阀 值 可 能 会 导致 算法 需要 更 多 的 从 


当 辐 射 环 境 中 存在 多 个 放射 源 时 ， 探 测 


器 通过 开 孔 方向 找到 最 大 辐射 剂量 率 对 应 的 角度 。 此 角度 即 为 第 一 个 待 搜寻 放射 源 的 位 置信 息 ， 将 此 角度 


转换 为 机 器 人 下 一 步调 整 角度 ， 机 器 人 朝 下 一 步调 整 角 度 移 动 一 次 固定 步 长 ， 


器 完全 裸露 ， 机 器 人 根据 环境 中 的 辐射 剂量 率 信息 


设 定 范 十 


当 粒 子 收敛 并 且 机 器 人 距离 放射 源 估 计 点 小 于 


WOE YL 


执行 改 ; 


射 源 并 放置 在 屏蔽 缸 中 ， 重 复 以 上 步骤 寻找 剩余 放射 源 。 


4 实验 结果 和 分 析 


4.1 仿真 实验 与 分 析 
为 验证 本 文 提 出 方法 的 准确 性 和 有 效 性 
intel(2.9GHz) 处 理 器 ，16GB 内 存 。 
(D 基 于 角度 信息 单 放射 源 搜寻 


， 首 


的 粒子 滤波 算法 ， 对 放射 
围 即 为 找到 放射 源 。 


先 在 matlab 软件 下 开 


第 一 个 放射 


展 放 射 源 搜寻 仿真 实验 ， 


之 后 铅 桶 下 降 ， 
源 进 行 渐进 式 搜寻 ， 
j 源 找到 后 ， 收 纳 该 放 


化 钠 探测 


计算 机 采用 


在 二 维 地 图 上 模拟 移动 机 器 人 放射 源 搜寻 实验 ， 实 验 场地 设置 为 30mx30m， 机 器 人 寻 源 起 始点 为 
(0m,0m)， 答 搜寻 放射 源 计数 率 了 为 8000cps， 粒 子 数目 N 为 5000， 其 计数 率 范围 为 [1000cps,20000cps]( 根 
据 多 次 仿真 可 得 ， 此 范围 包含 放射 源 计数 率 可 使 得 粒子 收敛 更 快 )， 环 境 中 本 底 辐 射 计数 率 , 为 10cps， 探 
测 器 计数 时 间 7 为 10s。 设 置 待 搜寻 放射 源 位 置 为 (10m,15m)， 图 9 所 示 为 移动 机 器 人 搜寻 单 放 射 源 的 整个 


定 粒子 区 域 ， 


图 9(a) 中 机 器 人 在 起 始点 通过 旋转 探测 器 获得 放射 源 角 度 范 
图 9(b)、9(c)、9(qd) 中 通过 执行 改进 的 粒子 滤波 算 


围 ， 角 度 范围 设置 为 实际 角度 +30"， 划 
法 对 放射 源 位 置 进行 渐进 式 搜寻 ， 最 终 定位 


放射 源 位 置 为 (10.05m,14.95m)， 误 差 为 0.07m， 总 耗 时 16.57 秒 ， 整 个 搜寻 过 程 经 过 了 18 个 观测 点 。 在 相 


同 设 定 条 件 下 ， 图 10 所 示 为 纯 粒 子 滤波 算法 ; 
误差 为 0.16m， 总 耗 时 21.43 秒 ， 整 个 搜寻 过 程 经 过 了 21 SW. Aa 
于 角度 信息 的 单 放 射 源 搜寻 与 纯 粒 子 滤波 单 放 射 源 搜寻 进行 对 比 实验 ， 设 置 探测 


行 单 放射 源 搜寻 ， 最 终 定位 放射 源 位 置 为 (9.87m,14.90m)， 


本 文 算法 的 搜寻 效率 高 ， 将 基 
区 域 为 10mxl0m、 


20mx20m、30mx30m、50mx50m、80mx80m、100mx100m， 其 对 应 放射 源 位 置 为 (3m,5m)、(6m,10m)、 


(10m,15m)、(16m,25m)、(26m,40m)、(33m,50m)， 机 器 人 搜寻 起 点 都 为 原 ) 
可 以 看 出 随 着 探测 区 域 增 大 ， 基 于 角度 信 


点 ， 其 它 参数 


WI AN 


REDE. ME 11 


TA BED RTSH E BH 2 PAOR T E E VTR o 


30 ETE ce 30 
25r 25 
20 20 
g g 
> 15 > 15 
10 上 10 
o 估计 放射 源 e 估计 放射 源 
© 实际 放射 源 s| ”实际 放射 源 
v 观测 位 置 ` v 观测 位 置 
- 粒子 y - 粒子 
+ 4 + 4 ow% i L L 4. L 
0 5 10 15 20 25 30 0 5 10 15 20 25 30 
x/m x/m 
(a) 
30 30 
2AF 25+ 
20 20 
x o 估计 放射 源 o 估计 放射 源 
E ae © 实际 放射 源 E © 实际 放射 源 
S > + mai |>" ? v 观测 位 置 
粒子 oa : BA 
10 10 w 
Pá r Bi 
sk a 5} 
Pd 
用 用 
ow 4 4 4 ow% + 4 
0 5 10 15 20 25 30 0 5 10 15 20 25 30 
x/m x/m 
(c) 
图 9 基于 角度 信息 单 放 射 源 搜 寻 ( 在 线 彩 图 ) 
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图 10 纯 粒 子 滤波 单 放 射 源 搜寻 (在 线 彩 图 ) 
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图 11 不 同 探测 区 域 搜寻 时 间 对 比 图 (在 线 彩 图 ) 
(2) 基 于 角度 信息 多 放射 源 搜寻 


为 验证 多 源 的 搜寻 情况 ， 依 然 设置 30mx30m 的 模拟 寻 源 场地 ， 机 器 人 寻 源 起 始点 为 (0m,0m)， 第 一 个 
源 的 参数 与 上 文中 单 源 的 参数 一 致 ， 第 二 个 放射 源 计 数 率 了 为 8000cps， 位 置 为 (20m,16m)， 第 三 个 放射 源 


计数 率 工 为 8000cps， 位 置 为 (28m,8m)， 环 境 


中 本 底 辐 射 计 数 率 即 为 10cps， 探 测 器 计数 时 间 z 为 108， 粒 


FRAN 为 5000， 其 计数 率 范围 为 [1000cps,20000cps]。 如 图 12 所 示 为 机 器 人 搜寻 过 程 ， 图 12(a) 中 机 器 
人 在 起 始点 通过 旋转 探测 器 测量 三 个 放射 源 的 剂量 信息 ， 选 取 最 大 的 剂量 信息 对 应 的 放射 源 为 第 一 个 搜寻 
点 ， 设 置 角度 范围 ， 划 定 粒子 区 域 ， 此 时 机 器 人 受到 三 个 放射 源 的 影响 ， 图 12(b)、12(c)、12(d) 中 通过 执 


行 改进 的 粒子 滤波 算法 , 实现 对 第 一 个 搜寻 点 渐进 式 搜寻 。 最 终 定位 第 一 个 放射 源 位 置 为 (11.42m,14.77m)， 
误差 为 1.44m。 
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图 12 搜寻 第 一 个 放射 源 (在 线 彩 图 ) 
机 器 人 搜寻 到 第 一 个 放射 源 后 将 其 进行 屏蔽 ， 其 将 不 对 后 续 辐 射 场 产 生 影响 ， 了 


引 次 进行 系统 初始 化 ， 


对 第 二 个 放射 源 进行 搜寻 ， 搜 寻 过 程 如 图 13 所 示 ， 最 终 定位 第 二 个 放射 源 位 置 为 (19.97m,15.95m)， 误 差 
为 0.06m。 
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重复 上 述 步骤 对 第 三 个 放射 源 进行 搜寻 ， 搜 寻 过 程 如 图 14 所 示 ， 最 终 定位 第 三 个 放射 源 位 置 为 


图 


13 搜寻 第 二 个 放射 源 (在 线 彩 图 ) 


(27.99m,8.01m)， 误 差 为 0.01m， 总 耗 时 47.58 秒 ， 整 个 搜寻 过 程 经 过 了 40 个 观测 点 。 
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图 14 搜寻 第 三 个 放射 源 (在 线 彩 图 ) 


将 单 源 搜寻 和 三 源 搜 寻 各 进行 十 次 仿真 实验 ， 其 中 单 源 搜寻 误差 和 三 源 搜寻 时 的 第 一 个 放射 源 估 计 误 


差 如 图 15 所 示 ， 从 图 中 可 以 看 出 ， 三 源 位 置 估 计 误 差 明 显 高 于 单 源 估 计 误 差 ， 但 都 在 1.5m 范围 内 。 相 比 
于 文献 [17] 设 定 固定 观测 点 通过 聚 类 算法 进行 多 源 热点 估计 , 本 文 所 提出 的 AOA 算法 可 实现 自主 定位 并 搜 
寻 放 射 源 。 
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图 15 单 源 估 计 与 三 源 估计 误差 对 比 图 (在 线 彩 图 ) 


4.2 机 器 人 测试 实验 与 分 析 
图 16 为 移动 机 器 人 系统 ， 


雷达 ， 首 先 通过 激光 雷达 在 辐射 场 环境 中 构建 二 维 栅 格 地 
如 图 18 所 示 ， 将 Co-60 放射 源 放置 在 (10.14m,17.16m) 处 ， 测 量 得 距离 


图 17 为 实验 所 使 用 放射 源 及 辐射 环境 地 


机 器 人 开始 沿 指定 路 线 行驶 ， 在 g 点 检测 到 放射 源 ， 机 器 人 停止 移动 ， 探 测 器 开始 上 升 并 旋转 〈 探 测 
升 表 示 使 用 探测 孔 进行 角度 测量 ， 下 降 表 示 使 用 整个 探测 器 测量 辐射 计数 率 )， 确 
粒子 滤波 算法 进行 寻 源 ， 最 终 确 定 放 射 源 估计 位 置 为 


新 粒子 集 ， 之 后 探测 器 下 降 ， 开 始 执行 改 ; 


图 ， 机 器 人 上 搭载 robosense 激光 


图 ， 机 器 人 在 30mx30m 栅 格 地 图 中 行驶 示意 图 
其 1m 处 的 辐射 计数 率 为 11482cps， 


器 上 
更 


定 放射 源 角 度 范围 ， 


(10.49m,16.91m)， 与 真实 放射 源 距离 误差 为 0.43m。 机 器 人 在 寻 源 过 程 中 会 到 达 不 同 的 观测 点 ， 如 表 3 所 


示 为 整个 放射 源 搜 寻 过 程 实验 数据 记录 。 


辐射 旋转 探测 器 
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16 移动 机 器 人 系统 (在 线 彩 图 ) 


(a)Co-60 (b)Cs-137 


(c) 辐 射 环 境地 医 
17 放射 源 及 辐射 环境 地 图 (在 线 彩 图 ) 
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图 18 寻 单 源 测试 流程 示意 图 (在 线 彩 图 ) 
表 3 Co-60 放射 源 搜寻 实验 数据 记录 


观测 点 观测 点 坐标 /(m,m) 估计 位 置 /(m,m) 误差 /m 


81 (12.59,11.08) (11.76,12.60) 4.84 


82 (12.20,12.51) (11.78,14.35) 3.25 


83 (11.85,14.09) (11.43,15.35) 2.22 
84 (11.08,15.49) (10.20,16.01) 1.15 
85 (10.96,16.29) (9.58,17.10) 0.56 
86 (10.70,17.04) (10.64,17.21) 0.50 
87 (9.90,17.48) (10.49,16.91) 0.43 


”为 验证 机 器 人 多 源 搜寻 效果 ,如 图 19 所 示 , 在 辐射 场地 图 中 ,将 另 一 Cs-137 放射 源 放置 在 (16.13m,19.05) 
处 ， 距 离 其 Im 处 的 辐射 计数 率 为 7173cps， 机 器 人 沿 指定 路 线 行驶 ， 在 g, 点 检测 到 辐射 异常 ， 探 测 器 开 
始 上 升 并 旋转 ， 确 定 两 个 放射 源 的 角度 范围 ， 将 探测 到 最 大 剂量 率 对 应 的 放射 源 设 为 第 一 个 搜寻 点 ， 更 新 
粒子 集 ， 探 测 器 下 降 ， 执 行 粒子 滤波 算法 进行 寻 源 ， 最 终 估计 第 一 个 放射 源 位 置 为 (10.89m,17.38m)， 与 真 
实 放射 源 距离 误差 为 0.78m。 将 第 一 个 放射 源 收集 屏蔽 起 来 ， 探 测 器 上 升 并 旋转 ， 确 定 第 二 个 待 搜寻 放射 
源 角 度 范围 ， 粒 子 初始 化 并 更 新 ， 探 测 器 下 降 ， 对 第 二 个 放射 源 进行 搜寻 ， 最 终 估计 第 二 个 放射 源 位 置 为 
(16.48m,19.10m)， 与 真实 放射 源 距离 误差 为 0.35m， 如 表 4 所 示 为 两 个 放射 源 搜寻 过 程 实验 数据 记录 。 
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图 19 寻 多 源 测试 流程 示意 图 (在 线 彩 图 ) 
表 4 Co-60 和 Cs-137 放射 源 搜寻 实验 数据 记录 
观测 点 观测 点 坐标 /(m,m) 估计 位 置 /(m,m) 误差 /m 
81 (13.04,11.85) (13.14,13.50) 4.73 
82 (12.83,13.50) (12.67,15.09) 3.27 
83 (12.43,14.94) (12.23,16.65) 2.15 
84 (12.07,16.65) (11.62,17.96) 1.68 
gs (11.51,17.20) (10.78,18.26) 1.27 
86 (10.44,17.56) (10.89,17.38) 0.78 
h, (10.26,18.10) (11.65,18.88) 4.48 
h, (11.94,18.20) (12.89,18.97) 3.24 
h, (12.89,18.32) (14.32,19.16) 1.81 
h, (14.22,18.54) (15.40,18.86) 0.75 
h, (15.42,18.68) (16.62,19.25) 0.53 
he (16.19,18.97) (16.48,19.10) 0.35 


5 


转 探测 器 进行 放射 源 搜寻 ， 通 过 仿真 验证 了 该 方 


结束 语 
针对 未 知 放射 源 搜 寻 问 题 ， 本 文 提 出 了 一 种 基于 角度 信息 的 未 知 放射 源 定位 方法 ， 机 器 人 通过 搭载 旋 
法 的 准确 性 和 有 效 性 ， 在 真实 寻 源 过 程 中 将 放射 源 相对 于 


探测 器 的 角度 转换 为 放射 源 相对 于 机 器 人 的 角度 ， 结 合 改进 的 粒子 滤波 算法 ， 大 大 提高 了 搜寻 效率 ， 实 现 
了 机 器 人 自主 寻 源 。 而 对 于 在 真实 环境 中 多 源 搜寻 ， 放 射 源 所 处 环境 复杂 多 样 ， 且 相互 之 间 存在 干扰 ， 导 
臻 放射 源 估计 误差 较 大 ， 未 来 将 通过 优化 粒子 滤波 算法 ， 使 用 机 械 辟 末端 搭载 小 型 辐射 探测 器 畏 助 搜寻 ， 


d 


对 局 部 放射 源 位 置 进行 精确 定位 ， 提 升 多 源 搜寻 准确 度 。 
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A Particle Filter Source Finding Method Incorporating Arrival Angles 
SHENG Shizun, XIAO Yufengt, YAN Dong,REN Zhenyu, YANG Shuang,ZHOU Yihang 


(Southwest University of Science and Technology Special Environment Robot Technology Sichuan 
Provincial Key Laboratory, Mianyang 621010, Sichuan,China) 

Abstract: The search and localization of unknown radioactive sources is an important research topic in the field of nuclear security 
inspection and nuclear emergency response. In order to improve the source finding efficiency and adapt to the multi-source 
environment detection, a particle filtering source finding method integrating the angle of arrival is proposed. Firstly, a hardware 
platform combining autonomous localization and angle-of-arrival sensing is constructed to introduce position and angle information 
to the detector; secondly, the angle-of-arrival information is taken into account on the basis of particle filtering, which can 
dynamically shrink the source searching area and improve the searching efficiency; lastly, the angle-of-arrival-guided robot attitude 
adjustment is adopted in the path planning of the autonomous source searching, which can enhance the flexibility of the robot in 
searching for the source. Simulation experiments prove that this method can work correctly and effectively, and tests using 
radioactive sources further verify the practicality of this method for multi-source search. 


Key words: Particle filtering; Angle-of-arrival information; Autonomous source searching; Multi-source search 
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